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Abstract 

In this paper the definition of manipulability ellipsoids for dual robot systems is given . A suitable 
kineto-static formulation for dual cooperative robots is adopted which allows for a global task space 
description of external and internal forces as well as absolute and relative velocities . The well-known 
concepts of force and velocity manipulability ellipsoids for a single robot are formally extended and 
the contributions of the two single robots to the cooperative system ellipsoids are evidenced. Duality 
properties are discussed. A practical case study is developed. 

1. Introduction 

Cooperative robots have been recognized by the robotics research community as offering enhanced 
capabilities over current single robot structures. Dual robot cooperation allows for performing tasks 
such as handling large, heavy and non-rigid objects, assembly and mating mechanical parts, which 
could not be executed by a single robot. Another advantage is the enlargement of the reachable 
workspace. All the above features play a crucial role, for instance, in space robotics applications 
where cooperative manipulation is often considered as an essential requirement. 

In spite of the potential benefits achievable with dual robots, the control problem becomes more 
complex due to the kinematic and dynamic interactions. A must for the solution of this kind of 
problem is constituted by an effective description of the kineto-static and dynamic relationship for a 
general dual robot system. To this purpose, the formulation proposed by Dauchez and Uchiyama [l] 
has been shown to be suitable to coordinated control schemes with equal importance attributed to the 
two robots performing a given task. Their approach is somewhat opposite to the master-slave strategy 
suggested by Luh and Zheng [2] which has been argued by Uchiyama et al. [3] to be unsuitable for 
practical position/force control of dual robots. 

It is believed that an important issue is the definition of quantitative measures of the enhanced 
performance offered by dual robot cooperation. It is well-known that the manipulability ellipsoids 
introduced by Yoshikawa [4] represent one of such measures for a single robot. The contribution of 
this work is to provide a systematic way of extending the above concept [4] to the dual robot case. In 
order to accomplish this goal, the formulation dictated in [3] is followed here. The motivation behind 
this choice is that it leads to a natural, straightforward derivation of manipulability measures which be 
consistent with those proposed in [4] and susceptible of an immediate physical interpretation for the 
closed-chain system created by the dual robots tightly handling an object. A similar, parallel research 
effort has recently been produced by Lee and Bejczy [5], although the definition of manipulability 
measures for a dual robot system is obtained according to different criteria related to the effect of 
one robot on the other, instead of regarding the closed-chain as a whole. 

A practical case study is worked out for two simple planar cooperative robots. Velocity and force 
static ellipsoids are obtained which show the correctness and functionality of the proposed approach. 
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2. Kineto-static formulation for two cooperative robots 

In the following the formulation of task space coordinates required for describing cooperative 
tasks is briefly summarized from [2]. For the purpose of the present work, the case when the two 
robots are rigidly attached to the object is considered, i.e. a rigid grasp. 

According to [2], the cooperative task is described in terms of a set of absolute coordinates and a 
set of relative coordinates. The static relationship between the generalized forces exerted by the two 
robots and the generalized forces acting on the object — external and internal — is presented first. 
The kinematic relationship will be derived by using the duality relation between forces and velocities. 
Fig. 1 illustrates two cooperative robots tightly grasping an object. Let m be the common dimension 
of the task spaces of the two robots and 


*•-(£) h ’ = (£) (1) 

denote the vectors of the generalized forces (forces fi , f 2 and moments Ui, n 2 ) exerted by the two 
end-effectors, respectively. Let then 

h "=(nJ *“(£) « 

denote the vectors of external and internal forces/moments acting on the object, respectively. Let be 


f = 



(3) 


It can be shown that 


K = Wf 


where 


( I 0 I 

\-Rla I —Rla 



(4) 

(5) 


with R la , Rta defined by f x X r la = -i2i a fi, f 2 x r 2o = -RzaU, respectively. I and 0 denote identity 
and null matrices of appropriate dimensions. Also it is 


where 


f = Vh r 


( I 



\-R2a 



( 6 ) 

(7) 


It can be recognized that the mapping V in (7) spans the null space of the mapping W in (5). This 
means that the external and internal force/moment vectors belong to orthogonal subspaces [6]. 

Once the static relationship has been established, the differential kinematic relationship is derived 
in a similar manner. Let 




( 8 ) 


denote the vectors of the velocities (translational x x , x 2 and rotational Ui , a> 2 ) at the two end-effectors, 
respectively. Let then 



( 9 ) 
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denote the vectors of external (absolute) and internal (relative) velocities, respectively. Let be 


-GO- 

(10) 

In force of the duality relation between forces and velocities which is 
virtual work in mechanics, it can be shown that 

derived from the principle of 

II 

0 

(11) 

and 


yr = V T i 

(12) 


with W and V defined in (5) and (7), respectively. 

3, Definition of manipulability ellipsoids 

The idea of measuring the manipulating ability of robotic mechanisms was first introduced in [4]. 
According to that concept, a force manipulability ellipsoid and a velocity manipulability ellipsoid can 
be defined for a single robot. Assume that an n-DOF robot is given and an m-dimensional task space 
is of interest, usually with m < n. It is well-known that 

t = J t {9) 7 (13) 

represents the static relationship between the task force vector 7 and the joint torque vector r through 
the transpose of the Jacobian matrix J(0) } with 0 denoting the joint displacement vector. Dually, 

v = J(6)0 (14) 

represents the kinematic relationship between the joint velocity vector 0 and the task velocity vector 
v through the Jacobian J(0), 

The unit sphere in the joint torque space 


r T r — 1 


(15) 


maps into the task force space ellipsoid 


l T (JJ T )l = 1 (16) 

which is called force manipulability ellipsoid [4]. Dually, the unit sphere in the joint velocity space 

9 T 9 = 1 (17) 


maps into the task velocity space ellipsoid 

v T (JJ T )“ 1 v= 1 (18) 

which is called velocity manipulability ellipsoid [4]. Note that the explicit dependence on 9 has 
been dropped in J . A direct comparison of (16) with (18) indicates that the principal axes (related 
to the eigenvectors) of the two ellipsoids coincide, whilst the lengths of the axes (related to the 
eigenvalues) are in inverse proportion. This inverse velocity-force relation is consistent with regarding 
the manipulator as a mechanical transformer [7]. Conservation of energy dictates that amplification 
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in velocity transmission must invariably be accompanied by reduction in force transmission, and 
vice-versa. 

In the following the concepts of force and velocity ellipsoids defined in (16) and (18) are formally 
extended to a two robot system, based on the kineto-static formulation given in the previous section. 
Let r»i and n 2 be the DOF’s of the robots, respectively. The static relationship (13) can be written 
for a two robot system as 

t = *^12 f (19) 

with f defined in (3) , where 

*=(r‘) (2») 

denotes the extended joint torque vector in an (n x + n 2 )-dimensional space, and 



denotes the extended Jacobian matrix. Solving eq. (19) for f yields 

f = (22) 

where the simbol “f” denotes a pseudo-inverse of proper dimensions; in this case it is a left pseudo- 
inverse. 

The external force manipulability ellipsoid and the absolute velocity manipul ability ellipsoid are 
derived first. Plugging (22) into (4) gives 


K = J^t (23) 

which expresses the relationship between the extended joint torque vector and the external force 
vector, through the matrix 

Jl 1 = l VJl! (24) 

which is analogous to the pseudo-inverse of the Jacobian J T in (13) for a single robot. At this point 
the formal definition of the external force manipulability ellipsoid can be given. The unit sphere in 
the extended joint torque space 

t T t = 1 (25) 

maps into 

= 1 (26) 

which is defined here as external force manipulability ellipsoid. Dually, the formal definition of the 
absolute velocity manipulability ellipsoid can be given. The unit sphere in the extended joint velocity 
space 

q r q=l (27) 

maps into 

yliJaJlV'ya = 1 (28) 

which is defined here as absolute velocity manipulability ellipsoid. Notice that in (27) 

q= (£) (») 
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indicates the extended joint vector. 

An attractive mathematical expression can be found for the matrix constituting the core 

of the two manipulability ellipsoids just defined in (26) and (28), which is directly related to the 
Jacobians of the two robots defined in (21). As shown in Appendix A, one may obtain 


JaJ? = + WI ) 1 )' 1 

(30) 

1=1,2 

(31) 


where the subscript / refers to the upper block of the matrix Jj which maps the joint torque vector 
tv into the sole force components of the task force vector f \ defined in (1) (i.e. excluding the moment 

components). It is worth noticing that in the particular case when i2, a = 0, the matrices J ? simplify 

to 

In the same formal manner as done above for the external force manipulability ellipsoid and the 
absolute velocity manipulability ellipsoid, the derivation of the internal force manipulability ellipsoid 
and the relative velocity manipulability ellipsoid is presented now. Plugging (22) into (6) gives 

t = J r r h r (32) 

with 

Jj = J&V. (33) 

It is to be remarked that, by virtue of the definitions (24) and (33) and of the structure of the matrices 
W and V y it results 

•7„ t V=0. (34) 

The unit sphere (25) maps into 

K(J r Jj)*r = 1 ( 35 ) 

which is defined as internal force manipulability ellipsoid . Dually, the unit sphere (27) maps into 

y T r{JrJj)~ l yr=l (36) 

which is defined as relative velocity manipulability ellipsoid. In this case too, an attractive mathe- 
matical expression can be found for the matrix J T Jj constituting the core of the two manipulability 
ellipsoids just defined in (35) and (36), which is directly related to the Jacobians of the two robots 
defined in (21). As shown in Appendix B, one may obtain 

J r jj = JJl + i 2 i 2 T (37) 

with 

jj = (-1 y-'j? + (("I Y- l (J?)nRla 0) t = 1,2 (38) 

where the subscript n refers to the lower block of the matrix Jj which maps the sole moment compo- 
nents of the task force vector £ defined in (1) into the joint torque vector r t . 

From eq. (34), it directly follows that 

jfj* -jfj* =0. (39) 
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It is worth noticing that in the particular case when i2, a = 0, the matrices JT simplify to JT ■ in this 
case, thus, eq. (39) trivially holds. ' 

Eqs. (30) and (37) suggest a nice interpretation of the way the Jacobians of the two robots 
combine to form the respective cores of the ellipsoids defined above. If each term of the type J J T is 
regarded as a generalized impedance, eq. (30) resembles the mathematical expression of the parallel 
of two impedances, whilst eq. (37) resembles that of the series of two impedances. Therefore, one 
would naturally be driven to generalize these results to the multiple robot case; this topic is under 
investigation. 

4. Case study 

Two 3-DOF planar robots are considered for the purpose of illustrating the application of the 
concepts presented in this work to a practical two robot system. For the sake of simplicity, the end- 
effectors of the two robots are supposed to be located in the same point (i.e. the physical object is 
removed); this implies that J, = J, = J { . This assumption is not restrictive at all, as formally shown 
above. Moreover, a two-dimensional global task space is assumed, i.e. only forces and linear velocities 
are of interest; the system thus possesses two redundant DOF’s. 

A CAD tool has been developed which is articulated into the following steps. The contact 
point of the two end-effectors is input, then the two redundant DOF’s are exploited to assign the 
orientation angles of the end-effectors. A software package for solving the inverse kinematics of 
general robot structures [8] is utilized to find the joint configurations and then the complete kineto- 
static characterization of the system. An option is provided to compute the ellipsoid of interest. 
The outputs are plotted by means of a graphic package. They illustrate the closed kinematic chain 
together with the principal axes of the ellipsoids of the two single robots and those of the dual robot 
system, in order that the manipulability of the cooperative system can be evaluated with respect to 
the single robot manipulabilities. 

Two complete sets of results for two different configurations of the dual robot system are displayed 
in Figs. 2 and 3 respectively. The ellipsoids of each robot are included for a better comprehension 
of the effects of the cooperation. It is remarkable that, in the second configuration, the two robots 
axe both proximal to singular configurations (see the shape of their ellipsoids). It can be recognized 
that the external force ellipsoids (Figs. 2a and 3a) are improved in that the ability of each robot to 
exert forces along a given direction is enhanced by the other, while the absolute velocity ellipsoids 
(Figs. 2b and 3b) show that the ability of each robot to perform motions along a given direction is 
penalized by the presence of the other. This result well agrees with practice, since it is intuitive that 
when two robots cooperate the static force is shared by them whereas the faster robot is slowed down 
by the other. Conversely, the ability of the system to absorbe forces along a direction is limited by 
the weaker robot of the chain (Figs. 2c and 3c), while the ability of the system to give rise to relative 
motions along a direction is supplied by both robots (Figs. 2d and 3d). All these conclusions reflect 
the concept of duality which is at the basis of the definition of the manipulability ellipsoids presented. 

5. Conclusions 


The concept of manipulability ellipsoids has formally been extended to the case of dual robot 
systems. A global kineto-static formulation of the closed chain created by two tightly cooperating 
robots has been exploited to define external and internal force manipulability ellipsoids. The corre- 
sponding absolute and relative velocity manipulability ellipsoids have been derived on the basis of the 
duality principle in mechanics. Functional expressions for these ellipsoids have been obtained through 
the Jacobians of the two robots and a practical rule of composition has been provided. The results 
achieved for a simple case study have validated the theoretical conclusions in view of the physical 
interpretation of the kineto-statics of a dual robot system. It has been conjectured that the proposed 
definitions can be extended to the multi-robot case, although the formulation of internal forces is 
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not straightforward. This issue, along with the analysis of different types of cooperation (e.g^ loose, 
soft) and the formulation of dynamic manipulability ellipsoids, will constitute the subject of further 

investigation. 
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Appendix A 


The matrix 
becomes 


The matrices Jj 


/jt defined in (24), by substituting the expressions of W in (5) and Ji 2 in (21), 


J^ = ( 1 ° T l °r) 

iK 

°V 

(A-l) 

\~R la I ~Rla I) 

V 0 


^ can be partitioned by rows as 

,rt_ fwM 

‘ -W f )J 

. = 1,2 


(A-2) 


where the subscripts / and n refer to forces and moments respectively. Plugging (A-2) in (A-l) gives 


t= U Tt 


(A 


^R2a{^2 )f 


) 


(A-3) 


which, by virtue of (31), can be compactly written as 


t 




(A-4) 


The matrix J a Jj in (26) can then be computed. First, one obtains 

jt _ ( + 


(A-5) 
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where the “~”’s have been dropped without loss of generality. Eq. (A-5) leads to 


j.ji = u44 + ^4)~ t j44(j44 + j?4r l 

+ 4r* j* ] 4(jf 4 + j44)-> 


that can be compacted into 


j«j T a = vf 4 +jf4r T - 


(A-6) 
(A— 7) 


By virtue of the property Jf' 4 = 1 , eq. (A-7) directly leads to (30). 

Appendix B 

The matrix Jj defined in (33), by substituting the expression of J 12 in (21) and V in (7), becomes 



The matrices JT can be partitioned by columns as 

JT = {VT), (•'fM > = 1.2 

Plugging (B-2) in (B-l) gives 

JT _( J? \,(0 ( J?) n R la \ 

r + \ 0 -(JT) 

which, by virtue of (38), can be compactly written as 

*=(-%)■ 


(B-l) 


(B-2) 


(B-3) 


(B-4) 


Computing the matrix J r Jj in (35) directly leads to (37). 



Fig. 1 - A dual cooperative robot system 
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robot 2 
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Fig. 2 



d 


- Manipulability ellipsoids for a first configuration 
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